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Abstract 

This  study  developed  a  data  processing  algorithm  for  a  space-based 
platform  tngaged  in  tracking  a  hyper^jonic  trans atmospheric  vehicle.  The 
geosynchrtyiais  platform  was  assumed  to  possess  passi*/e  sensors  measuring 
target  position  from  data  angles.  The  hypersonic  vehicle  was  assumc?d  to 
be  operating  in  the  outer  fringes  of  the  atmosphere. 

Four  element  state  and  six  element  state  Kalman  filters  were 
developed,  coded,  and  tested  against  typical  transatmospheric  flight 
profiles.  Accuracy  of  tl»e  filters  in  estimating  position,  velocity, 
heading,  and  acceleration  was  determined  for  1,  5  and  10  second  data 
intervals. 

Frorv  this  test  data,  it  was  concluded  that  the  six  element  state 
Kalman  filter  posed  a  viable  option  for  tracking  and  estimating 
performance  parameters  of  hypersonic  aircraft. 


TRAC^  ING  A  HN-PERSONIC  AIFOWT  FROM  A  SPACE  PLATFORM 


I .  Introduction 


TransatmsspForic  vetvicle  (TAV)  tertmology  svntheoi7.es  the? 
advantages  of  airbreathmg  aircraft  and  platforms  in  orbit. 

Airbreathing  aircraft  have  long  enjoyed  the  advantage  of  operating  iron 
a  variety  of  bases,  many  remote  and  outside  the  effective  range  of 
hostile  detection  networks.  The  maneuverable  nature  of  aircraft  allows 
frequent  inflight  changes  to  course  and  destination,  nxich  to  the  chagrin 
of  those  attempting  to  predict  the  when  and  where  of  a  possible  hostile 
flight.  It  IS  no  surprise  that  airbreathing  aircraft  are  the  weapon 
system  of  choice  when  it  comes  to  the  invaluable  tactic  of  operational 
surprise.  Unlike  airbreathing  aircraft,  platforms  in  orbit  do  not  enjoy 
the  advantage  of  operating  outside  the  range  of  detection  networks. 
Indeed,  they  are  continuously  in  full  view  of  a  host  of  tracking 
networks.  These  platforms  are  handicapped  in  their  ability  to 
frequently  maneuver,  as  well,  being  constrained  by  fuel  requirements  and 
the  dynamics  of  space  operations.  What  platforms  in  orbit  lack  relative 
to  their  airbreathing  counterparts,  however,  they  possess  in  the  way  of 
range,  sfseed  and  endurance.  Operating  in  the  ultimate  "high  ground'  , 
on-orbit  platforms  can  reach  worldwide  targets  in  a  matter  of  minutes 
and  do  so  at  a  time  unpredictable  to  observers. 

A  TAV,  possessing  the  advantages  of  both  airbreathing  aircraft  and 
on-orbit  platforms,  would  be  a  formidable  opponent.  Central  to  efforts 
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to  defend  against  such  a  system  is  the  ability  to  accurately  detect, 
observe,  and  predict  any  given  TAV  flight.  Success  in  this  task  is  made 
possible,  in  large  part,  by  a  distinct  disadvantage  of  the  TAV  concept: 
the  TAV  is  second  only  to  the  sun  as  an  infrared  source.  The  TAVs  hot 
and  powerful  engines  are  easy  prey  for  currently  available  infrared 
sensor  technology.  Even  in  the  absence  of  engine  operation,  the  TAVs 
proposed  Mach  20  operation  in  the  outer  fringes  of  the  atmosphere,  will 
result  in  exceedingly  hot  airfoil  surfaces.  These  surfaces  again 
provide  a  strong  infrared  signature  to  any  observing  sensor. 

Objective 

This  thesis  capitalizes  on  the  TAVs  infrared  visibility  and 
investigates  details  of  the  associated  tracking  problem.  The  specific 
objective  is  to  develop  a  capability  to  process  data  from  a  tracking 
node  into  infortr-ation  that  exposes  as  much  of  a  TAVs  capabilities  and 
intentions  as  possible.  The  product  of  v:his  thesis  will  be  validated 
software  algorithms  designed  to  receive  data  from  a  specific  tracking 
sensor  and  estimate  position,  direction,  speed,  and  acceleration  of  a 
TAV  under  observation. 

Approach 

The  approach  to  achieving  this  objective  can  be  subdivided  into 
five  areas.  First,  an  assessment  of  the  system,  in  a  general  sense, 
must  be  completed.  Where  is  the  tracking  sensor?  Where  is  the  TAV? 

Are  there  any  underlying  assumptions  to  be  stated?  Second,  the  dynamics 
of  the  TAV  must  be  modelled  accurately  by  equations  of  motion  permitting 
propagation  of  typical  flight  profiles  over  time.  Third,  the  nature  of 
the  sensor  data  itself  must  be  expressly  defined  and  related  to  the 
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TAV/’s  noticn.  Fourth,  an  algorithm  to  process  this  sensor  data  and 
estimate  the  TAVs  position,  heading,  speed  and  acceleration  must  te 
generated.  In  this  thesis,  a  Kalman  type  estimation  algorithm  will  be 
employed  to  this  end.  Finally,  the  estimation  algorithm  must  be  tested 
against  typical  TAV  flight  profiles  (truth  models)  to  deterroine  how 
accurately  the  algorithm  estimated  true  position,  heading,  speed,  and 
acceleration.  The  next  section  addresses  the  first  of  these  five  steps. 

System  O/erview 

The  tracking  sensor  platform  will  be  located  in  a  geosynchronous 
orbit.  This  orbit  affords  uninterrupted  coverage  of  a  large 
geographical  region  where  TAV  activity  might  be  expected.  Realizing 
that  a  TAV  at  hypersonic  transatmospheric  flight  will  almost  certainly 
produce  a  strong  thermal  signature  from  exhaust  products  and  high  speed 
flow  over  airfoil  surfaces,  the  platform  will  carry  a  passive  infrared 
sensor  package.  For  this  study,  sensor  error  introduced  by  platform 
pointing  and  position  uncertainties  will  not  be  cersidered.  Vibration 
of  the  sensor  will  be  assumed  to  be  negligible. 

The  TAV  will  be  modelled  as  a  hot,  isotropically  radiating  point 
source  operating  in  the  outer  fringes  of  an  atmosphere  surrounding  a 
perfectly  spherical  and  rotating  earth.  The  residual  atmosphere  between 
the  TAV  and  sensor  should  introduce  negligible  atmospheric  jitter  and 
distortion  into  sensor  position  estimates.  In  addition,  the  ratio  of 
the  geosynchronous  range  to  the  maximum  height  of  the  atmosphere  is  very 
large,  allowing  the  assumption  of  negligible  TAV  motion  in  the  vertical 
(increasing/decreasing  altitude)  direction. 
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1 1 .  Transatnosphgric  Vehicle  Dynamics  Model 


As  stated,  one  of  the  prinvary  objectives  of  this  thesis  is  to 
produce  an  algorithm  that  estimates  TAV  position,  direction,  speed,  and 
acceleration.  The  evaluation  oV  this  algorithm  requires  knowledge  of 
the  true  position,  direction,  speed,  and  acceleration  thus  allowing  a 
direct  comfiarison  to  assess  the  estimator's  accuracy.  The  TAV  dynamics 
model  is  the  algorithm  that  constructs  this  true  trajectory. 

Definition  of  Dynamic  Parameters 

TAV  dynamics  will  be  specifically  represented  by  six  dynamic 
parameters:  longitude,  latitude,  heading,  speed,  intrack  acceleration, 
and  tr.insverse  acceleration.  As  previously  noted,  TAV  altitude  relative 
to  the  surface  of  the  earth  is  assumed  to  be  a  constant  zero  and  hence 
does  not  represent  a  meaningful  dynamic  parameter.  This  assumption  is 
the  result  of  the  atmosphere's  maximum  height  being  much  smaller  than 
the  great  range  involved  with  a  geosynchronous  sensor. 

The  dynamics  algorithm  and  the  estimation  algorithm  express 
TAV  position  in  terms  of  earth  longitude  (X.)  and  earth  latitude  (6).  In 
these  algorithms,  longitudes  east  of  the  Greenwich  Meridian  are  taken  as 
positive  numbers,  while  longitudes  west  of  the  Greenwich  Meridian  are 
taken  as  negative.  North  latitudes  are  taken  as  positive  and  south 
latitudes  as  negative  numbers,  zero  latitude,  of  course,  being  the 
equator. 

TAV  direction  of  travel  is  expressed  in  terms  of  heading  (h). 
Heading  is  the  angle  measured  positive,  in  the  clockwise  direction,  from 
the  line  connecting  the  TAV's  position  with  the  north  fDole.  The 


2-1 


ccnvention  for  heading  is  illustrated  in  Figure  2.1: 


aOKTHPOLS 


EQUATOR 


Figure  2.1.  Convention  for  TAV  Heading 

TAV  velocity  (V)  will  always  be  defined  as  the  rate  of  change  of 
position  along  the  direction  of  heading. 

The  acceleration  of  the  TAV  is  decomposed  into  two  distinct 
components,  intrack  acceleration  (a  )  and  transverse  acceleration  (a  ). 

I  T 

is  the  measured  rate  of  change  of  speed  along  the  direction  of  the 
heading.  Accelerations  are  considered  positive,  decelerations  negat. ve 
a^  is  the  acceleration  normal  to  the  direction  of  heading  with 
accelerations  out  the  left  wing  considered  positive. 

Equations  of  Motion 

The  TAV  equations  of  motion  can  be  expressed  in  terms  of  the  six 
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parameters  in  the  previews  secticn.  Censider  Figure  2.2: 


Figure  2.2.  TAW  Dynamics  Over  a  Small  Time  Interval 


Over  time  interval,  dt,  the  TAV  travels  angular  distance  d\  and  d6  from 
some  starting  longitude/ latitude  of  \  and  6.  The  velocity  nf  TAV 
can  be  broken  into  velocity  components  across  lines  of  latitude  and 

across  lines  of  longituoe  Assuming  the  effect  of  the  earth's 

curvature  on  the  TAV  trajectory  is  negligible  over  time  interval  dt,  the 
planar  geometry  of  this  motion  is  represented  by  the  planar  triangle  in 
Figure  2.3. 

From  basic  dynamics,  velocity  =  angular  velocity  x  radial  distance. 
In  the  direction  of  changing  latitude 

V ,  =  to-  •  R  (2.1) 

6  o  e 
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Figure  2.3.  Planar  Approximation  of  TAV  Trajectory  Over  Time  dt 


Eq  (2.1)  car.  be  rewritten 


V-cos  h  =  ^  •  R 
dt  e 


(2.2! 


where  from  Figure  2.3,  =  V-sin(90*-h) ,  or  by  trigononetric  identity 


=  V'cos  h.  Rearranging,  produces  the  first  equation  of  motion 

V‘Cos  h 


6  = 


(2.3: 


The  equation  of  motion  for  X  is  derived  in  similar  fashion.  Across 


lines  of  longitude 


velocity  across  lines  of  longitude 
is  the  TAV  angular  rate  of  change  in  longitude 
f^g'sin  6  is  the  radial  moment  arm  as  a  function  of  latitude 

From  Figure  2.3,  =  V-cos(90°-h)  or  =  V’sin  h  .  Eq  (2.4)  can  now 

be  rewritten 


dX 


V  •  sin  h  =  ^  •  R  •  sin  6 
dt  e 


(2.5) 

Rearranging  prorJuces  the  equation  of  motion  for  a  non-rotating  earth 


■  _  V-  sin  h 

R  •  sin  6 
e 

Correcting  for  the  contribution  of  the  earth's  rotation  to  the  TAV 


(2.6) 


tr  Rectory  results  in  the  second  equatioTi  of  motion 

‘  V-  sin  h 

X  =  5 - : — 7-  - 

R  -sin  6  e 


(2.-n 


e 

To  derive  the  equations  of  motion  for  h  and  V,  two  additional  reference 
frames  must  be  introduced.  First,  consider  the  EMZ  frame  with  origin  :t 
the  TAV  (Figure  2.4): 


igure  ’'..4.  ENZ  Reference  Frame 
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The  E  axis  always  points  due  east,  while  the  N  axis  points  ccntinucxjsly 
to  the  north.  The  final  axis,  Z,  rounds  cut  this  right  handed 
ortfxjgonal  set  and  points  directly  to  the  zenith. 

The  second  reference  frame,  the  body  reference  frame  B,  will  also 
be  attached  to  the  TAV.  In  this  frame  of  reference,  points  out  the 
TAV  nose,  B^  cut  the  TAV  left  wing,  and  B^  rounds  out  the  right  handed, 
orthogonal  system.  If  small  bank  angles  are  assumed  for  any  TAV  flight 
profile  then  the  ENZ  frame  and  B  frame  are  related  as  in  Figure  2.5. 
Note  the  coincidence  of  the  B_  and  the  Z  axes. 


From  the  geometry  of  Figure  2.5,  the  coordinate  transformation  from  the 
ENZ  frame  coordinates  to  B  frame  coordinates  are 


E  =  sin  h  Bj^  -  cos  h  B^ 

^  ^ 

N  =  cos  h  B^  +  sin  h  B^ 


(2.8a) 
(2.8b) 
(2. Be) 
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With  these  reference  frames  and  the  above  transformation  established, 
the  equations  of  motion  for  h  and  V  will  now  be  derived. 


The  inertial  velocity  of  the  TAV,  expressed  in  the  body  frame  is 


(2.9) 


The  inertial  acceleration  of  the  TAV  is 

dt 

''  —  Ki 

=  ^  (V  Bi)  +  w  X  V 

•  —  bv 

=  V  B^  +  u)  X  V  Bjj^ 

Now,  expanding  the  w  term  in  Eq  (2.12) 

—  bv  —  b  EN2  —  EN2  V 

w  =  w  +  w 


(2.10) 

(2.11) 

(2.12) 


(2.13) 


where 

w  IS  the  angular  velocity  of  the  B  frame  with  respect  to  the 
inertial  reference  frame 

w  ^  IS  the  angular  velocity  of  the  B  frame  with  resisect  to  the 
ENZ  reference  frame 

w  IS  the  angular  velocity  of  the  ENZ  frame  with  respect  to  the 

inertial  reference  frame. 


From  Figure  2.5 


—  b  ENZ  •  '' 
“  =-h  Bj 


and  realizing  that  rotation  of  the  ENZ  frame  with  respect  to  the 


inertial  frame  consists  of  contributions  from  the  earth's  rotation  (w  ) 

e 

and  the  TAV  angular  velocities 


—  ENZ  I  —  ^  — 

W  =03+03 

e  TAV  MOTION 

=  03  +  \  +  <5 

e  TAV  TAV 


(2.15) 

(2.16) 


-•  03^  +  A. ’COS  6  N  +  X-sin  6  Z  -  <5  E  (2.17) 


In  the  ENZ  frame 


03  =  03  •  cos  6  N  +  w  •  sin  6  Z 
e  e  e 

and  substituting  this  result  into  Eq  (2.17)  produces 


(2.18) 


2- 


(2.19) 


-6  E  +  (\  +  w  )‘COS  £  N  +  (X,  +  w  )-sin  6  Z 
e  e 


Transforming  Eq  (2.19)  from  ENZ  coordinates  to  the  body  framt* 
coordinates  with  the  transformations  of  Eq  (2.8)  results  in 

Chits  t  * 

oj  =  (X.‘cos  6 'COS  h  -  6 "Sin  h  +  to  'cos  o*^ds  h)  B, 

+  (\‘Cos  (5 'Sin  h  +  6 ‘COS  h  +  'o  'cos  £*sin  h)  0_ 

e  .2 

+  (X'Sin  6  +  to  ‘s.n  6)  B, 
e  3 

Substituting  Eq  (2.1^)  and  Eq  (2.20)  into  Eq  (2.13)  results  xr.  the 


expanded  form  of  to 


«o  =  <0^  Bj^-^  to,  Bj  ^  0,3  B3 


where 


(2.20) 


w.  “  (X’cos  6 ‘COS  h  -  £'sin  h  +  to  "cos  £'cos  h)  B 
1  e 

(0-,  =  (X'cos  6 ‘Sin  h  +  4* cos  h  to  •  cos  £’sin  h)  B, 

■*  .  .  ■*■ 
to-  =  (X'sin  6  +  to  “sin  6  -  h)  B, 

3  c  3 

With  to  now  expressed  in  body  frame  coordinates,  Eq  (2.J2)  can  be 
written 


(2.21) 

(2.22) 

(2.23) 

(2.24) 


A  =  V  Bj,  + 


B. 


to. 


V 


B, 


to„ 


B, 


to_ 


(2.25) 


where  the  notation  inside  the  brackets  represents  a  cross  product. 
Since  notion  in  the  vertical  (B^)  direction  is  being  ne;  Ircted  due  to 
assumptions  of  Chapter  I,  the  acceleration  in  the  B^  ditection  will  be 
zero,  so  Eq  (2.25)  reduces  to 


A  =  V  B  +  (V-.\-sin  6  +  V'OJ  'sin  6  -  Vh)  3_, 

1  e  2 

Substituting  Eq  (2.7)  for  \  in  Eq  (2.26)  produces  the  result 

'/’sir  h’sin  6 


(2.26) 


A  =  V  B^  + 


-  V-  h 


R  ■ cos  6 
e 


B„ 


(2.27) 


Frco  the  definitions  of  the  acceleration  parameters  in  the  previous 
section 
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intrack  acceleration  2  a  =  A-B 

X  1 


»2.2e) 


transverse  acceleration  s  a  =  A-B. 

T  * 


(Z.29) 


a  =  V 

i 


V^‘Gin  h'sin  6 
A  'COS  O 

e 


12. :i) 


Fro'n  these  tv^o  equations  come  the  equations  of  motion  for  V  and  h: 


V  =  a 


12.321 


*  T  V-sin  h’Sin  6 

h  ®  ■  ■■■.— I. .. — ■_  Ill 

V  R  ‘COS  6 

e 


12.33.) 


To  complete  the  set  of  six  equations  of  motion  in  the  six  dynamic 
parameters  6,  h,  v,  a^,  and  a^,  assume  for  the  TAV  system  constant 
jerk.  That  is 


a^  =0 


(2.34) 


a  =0 

T 


(2.35) 


Eqs  (2.3),  (2.7),  (2.32),  (2.33),  (2.34)  and  (2.35)  define  six  equations 
of  motion,  in  the  six  dynamic  parameters,  for  TAV  motion  over  a  rotating 


earth.  Summarizing 


V-cos  h 


(2.3) 


•  V*  sin  h 

A.  =  5 - ^ - -  -  W 

R  •  sin  o  e 
e 


(2.7) 


V  =  a 


(2.32) 


h  =  T  ^  V- Sin  h- sin  6 

V  R  -cos  6 

e 


(2.33) 


a  =0 
I 


(2.34) 
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Propagation  of  tbo  Equations  o'f  ftaticn 


The  dynamics  of  the  TAV  have  been  reduced  to  a  system  of  six  fir  At 
order  equations  of  form  x«  f(x,t)  where  x  is  the  vector  consisting  of 
the  siH  TAV  dynamic  parameters.  varying  the  values  assigned  i<  over 
time,  the  data  for  any  TAV  profile  can  be  generated  by  integrating  the 
six  equations  of  motion  in  parallel. 

In  this  thesis,  a  predictor-corrector  method  developed  by  Hamming 

was  used  to  propagate  the  equations  of  motion  over  time.  Given  initial 

conditions  for  x,  the  time  step  size,  and  the  right  hand  side  of  the 

equations  of  motion,  the  Haming  algorithm  produced  detailed  time 

histones  for  ,\,  5,  h,  V,  a^,  and  a^.  To  prevent  numerical  difficulties 

during  the  integration,  care  was  taken  in  selecting  the  units  associated 

with  each  one  of  these  parameters.  This  involved  expressing  each 

pjarameter  in  units  that  make  it  equivalent  in  magnitude  to  ♦’tx?  other 

parameters  during  the  integration.  For  this  thesis,  6,  and  h  were 

expressed  in  radians,  V  was  expressed  in  DU/TU,  and  the  accelerations 

2 

(a^  and  a^l  were  expressed  in  IXJ/TU  (6s).  These  units  were 
successfully  implemented  in  all  algorithms. 


III.  Sensor  Data  Model 


In  this  chapter,  the  process  of  data  collection  at  the 
geosynchronous  sensor  is  developed.  The  definitions  of  the  data 
clcwents  are  encaiorated,  follOMCd  by  discussion  of  preprocessif^g  of  this 
data  before  its  input  to  the  Kalman  estinvaticn  algorithm.  This 
preprocessing  allots  simplification  cf  the  Kalman  algorithm  code. 

Definition  of  Data  Elements 

As  stated  earlier,  the  platform  carrying  the  sensors  is  located  in 
a  geosynchronous  orbit.  The  sensors  themselves  are  assumed  to  be  of  the 
passive  infrared  type,  collecting  data  on  the  position  of  the  TAVs 
thermal  signature.  This  position  data  consists  of  tio  measured  angles, 
a2i«njth  (As)  and  elevation  (El),  both  represented  in  Figure  3.1. 


NORTH  POLE 


EQUATOR 


GREAT  CIRCLE 


Figure  3.1.  Azimuth  and  Elevation  Data  Angles 
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Azinuth  is  defined  as  the  measured  angle  from  the  censor  platform  s 
constant  longitudinal  position  to  the  great  circle  connecting  the 
platform's  equatorial  nadir  and  the  TAV  itself.  It  is  measurcjd  positive 
in  the  clockwise  direction.  Conveniently,  any  great  circle  running 
through  the  platform's  nadir  appears  as  a  straight  line  from  the  sensor 
platform.  This  ensures  that,  regardless  of  the  TAV  s  position  along  any 
such  great  circle,  the  azimuth  is  identical. 

The  elevation  angle  locates  the  TAV  s  precise  position  along  the 
identified  great  circle.  It  is  measured  from  the  nadir  to  the  TAV 
directly.  It  can  be  alternately  thought  of  as  the  angle  subtended  by 
the  nadir-TAV  segment  when  measured  from  the  sensor  platform.  The 
elevation  is  ali-iays  a  positive  angle  by  convention  and  never  exceeds 

e.6*. 

Associated  with  the  sensor  data  is  some  uncertainty  due  to  sensor 
position  inaccuracies,  pointing  inaccuracies,  sensor  platform  jitter 
etc.  These  effects  will  not  be  considered  independently,  but  their  sum 
effect  will  be  modelled  in  terms  of  the  introduced  sttjndard  deviation 
(O')  to  the  data.  Osedaez  (2:3),  estimates  the  nominal  data  standard 
deviations  as  3.5  x  10  ^  radian-i  for  azimuth  measurements  and  4.3  x  10  ^ 
radians  for  elevation.  These  values  will  be  carried  forward  into  this 
thesis,  as  well,  and  correspond  to  variances  in  the  data  covariance 
matrix  [0].  If  the  azimuth  and  elevation  angles  are  assumed  to  be 
statistically  independent  of  one  another  in  a  given  set  of  data,  then 
all  covariances  in  [QJ  are  zero.  This  information  completes  [Q]  : 


z 

• 

-p 

• 

CQ]  = 

a 

AS 

0 

0 

2 

J 

s 

1.225  X  10 

0 

0 

1.B49  X  10““  _ 
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Preprcxessing  ol  the  Data  Stream 

The  azimuth  and  elevation  angles  have  TAV  positicr*  information 
imbedded  in  them.  Instead  of  processing  the  raw  data  angles  in  the 
Kalman  estimation  algorithm,  it  is  very  advantageous  to  extract  this 
position  information  by  transforming  the  angle  data  to  raw 
longitude/ latitude  data.  In  doing  so,  the  data  now  directly  provides 
two  of  the  six  dynamic  parameters  characterizing  TAM  motion  (X  and  6). 
Inputting  this  longitude/ latitude  data  to  the  Kalman  estimation 
algorithm  greatly  simplifies  two  of  the  matrices  required  by  that 
algorithm.  These  matrices,  CG3  and  [H],  are  discussed  in  detail  next 
chapter.  The  remainder  of  this  section  pursues  the  data  transformation 
itself. 

Consider  the  planar  triangle  (Figure  3.2)  with  vertices  at  the 
sensor,  earth’s  center,  and  the  TAM: 


Figui"e  3.2.  Planar  Sensor-Earth's  Center-TAV  Triangle 
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From  the  law  of  sines  for  planar  triangles 

R 

r  _  e 
sin  y  ~  sin  El 


(3.2) 


where 


r  IS  the  distance  from  the  sensor  to  the  earth's  center 

R  is  the  radius  of  the  earth 
e 

Solving  for  the  interior  angle  y 


-i 

Y  =  sin 


r-sin  El 
R 

e 


(3.3) 


From  the  geometr/  of  Figure  3.2,  it  is  evident  at  y  -  90* ,  the  TAV  is 
imminently  fading  over  the  horizon  from  the  sensor's  point  of  view. 
Indeed,  for  y  <  90*.  the  sensor  "sees"  the  TAV  as  behind  the  earth.  In 
view  of  these  observations,  the  range  of  values  for  y  xs  restricted; 

90*  <  y  <  100*  (3.4) 

where  y  =  100*  is  achieved  when  the  TAV  is  directly  over  the  sensor 
nadir  point  (El  =0*),  With  y  determined,  a  is  evaluated  from  the 
observation  that  interior  angles  of  a  planar  triangle  sum  to  100  ; 

a  =  100*  -  (El  +  y)  (3.5) 

Now  that  y  and  a  are  evaluated  in  terms  or  r,  R^  and  El,  the  more 
complicated  spherical  geometry  of  the  problem  will  provide  the 
relationships  expressing  longitude  and  latitude  as  a  function  of  the 
azimuth  and  elevation  angles.  This  spherical  geometry  is  depicted  in 
Figure  3.3. 

Applying  the  law  of  sines  for  oblique  spherical  triangles  relative 
to  Figure  3.3 

^  ^ _  (3.6) 

sin  (90°-  Az)  sin  90° 
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Figure  3.3.  Spherical  Geometry  of  TAV  Tracking  Problem 


or 


sin  <5  =  sin  a ’sin  (90  -  a)  (3.7) 

which  by  trigonometric  identity  and  further  manipulation  reduces  to 

6  =  sin”^  (sin  o-cos  Az)  (3.8) 

Substituting  Eqs  (3.3)  and  (3.5)  for  a  in  Eq  (3.8)  results  in  the  first 


oi  two  desired  data  trans-formations: 


6  =  sin  *|^sin|El  +  sin  ^^‘sin  Eljjcos  Az 

The  second  transformation  must  produce  a  relationship  expressing  X  as  a 
function  of  Az  and  El .  This  relationship  can  again  be  determined  from 
the  geometry  of  Figure  3.3.  It  is  clear  from  the  figure  tf«t 

\  =  \  +  A.\  (3.10) 

vihere 


} 


(3.9) 


\  is  the  TAV  longitude  position 

\  is  the  longitude  position  of  the  sensor 

s«n 

IS  the  longitudinal  distance  measured  from  the  sensor  to  the  TAV 
Since  .\  is  predetermined,  calculation  of  A.\  will  complete  this  data 

•«n 

transformation  to  the  TAV  s  longitudinal  coordinate.  Recognizing  the 
spherical  triangle  of  Figure  3-3  as  a  right  spherical  triangle 

sin  £i.\  =  tan  6 -cot  (90*-  Az)  (3.11) 

which  by  trigonometric  identity  and  further  manipulation  reduces  to 

£i}.  <=  sin“*  tan  6 '  tan 

Substituting  Eqs  (3.9)  and  (3-12)  into  Eq  (3.10)  completes  the 
transformation  from  data  angles  to  longitude: 


(3.12) 


\  =  V 


+  sin 


^  tan|^sin  ^l^sinlEl 


+  sin 


sin  El]] 
■cos  Az^j tan  Azj 


(3.13) 


Given  any  Az  and  El  data  set,  Eqs  (3.9)  and  (3.13)  transform  the  data 
set  to  \  and  <5  data.  Since  the  geometry  of  the  problem  ensures  both  6 
and  A\  will  always  lie  in  the  interval  [-n/2,n/23,  these  equations  have 
no  complicated  quadrant  uncertainties. 

Recall  the  Az  and  El  data  had  an  associated  data  covariance  matrix, 
[0],  with  variances  reflecting  the  error  imbedded  in  tl-e  data 
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measure<Tents.  No  such  data  covariance  nvitrix  for  the  >,  and  6  data 
exists  to  this  point.  By  transforming  [03,  however,  with  the  Jacobian, 
[J],  of  the  mathematical  relationship  between  Az/El  data  and  \/6  data, 
the  data  covariance  for  X  and  6  is  determined.  That  is 

[03*  «  CJ3*C03*CJ3’^  (3.1A) 


where 


[03  is  the  data  covariance  associated  with  the  As  and  El  data 

[J3  IS  the  Jacobian  matrix  for  the  system 

« 

[03  is  the  data  covariance  associated  with  the  .\  and  6  data 

Recognizing  that  Eqs  (3.9)  and  (3.13)  are  of  the  form 

X  <=  f^(Az,El)  (3.15) 

6  =  f  (Az.El)  (3.16) 

z 

the  [J3  and  its  transpose  [J3^  have  elements  derived  from  partial 
derivatives: 


[J3  = 


df 

1 

<3A2 

d1 

2 

dAz 


(?T 

1 

JEl 

di 

2 

asi 


(3.17) 


[J3'^= 


di 

1 

dAz 

di 

1 

dE\ 


di 

2 

dAz 

df 

2 

dEl 


(3.18) 


where 

df 

_ 1  _ 

dAz  “ 


J-i/z 


sec 


l^sin  *^sinjEl  +  sin  *|^-^‘sin  Eljjcos  Az^ 
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■  {l*  [l-  [^-sinEl]  ] 

Eqs  (3.17)  and  (3.18)  complete  the  elements  required  for  Eq  (3.14). 
The  data  covariance  for  longitude  and  latitude  data  is  now  resolvable 
from  Eq  (3.14).  This  data  covariance  matrix  and  the  attendant  longitude 
and  latitude  data  is  now  ready  for  processing  within  the  Kalman 
estimation  algorithm. 
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Six  State  Element  Halman  Filter  Development 


In  selecting  the  optimal  estimator  appropriate  to  the  TAV  ti  act 
c-oblem,  it  is  essential  to  first  recognise  that  estimation  of 

pa'*amoters  is  a  stochastic  process.  The  unpredictability  v-Jitr  Ar.*-.*' 
TA,  may  maneuver,  at  a  gi/en  instant,  rules  out  an,  possibility 
Vto- ■  -  -'Nn  this  problem  deterministically.  In  light  of  this  stoch-io' ;c 
r.al.,r  ; ,  a  sequent*.-,  estimator  is  preferred  over  a  batch  estimation 
algorit-.n  lixe  a  l.-asl  squares  method. 

Two  sequ€?ntial  estimators  considered  were  the  Bayes  filter  and  the 
Kalman  filter.  Although  the  Bayes  fi'ter  retains  advantages  over  the 
Kalman  filter  in  sta.  t  up  with  tie  initial  data,  the  advantage  enjoyed 
by  the  Kalman  filter  in  processing  demands  clinched  its  selection.  This 
advantage  in  processing  stems  from  the  fact  that  the  Bayes  filter 
algorithm  requires  matrix  inversions  on  the  order  of  the  state  vector, 
which  for  this  problem  amounts  to  a  6x6  matrix  inversion.  The  Kalman 
filter,  on  the  other  hand,  requires  inversions  on  the  order  of  the  data 
vector;  in  this  case  a  2x2  matrix  inversion  (a:102). 

This  chapter  derives  the  six  state  Kalman  filter  that  will  process 
longitude  and  latitude  data  from  an  observed  TAV  trajectory  and  output 
estimates  for  the  TAV's  current  position,  heading,  velocity,  and 
acceleration.  A  detailed  description  of  the  specifically  tailored 
elements  that  make  up  the  Kalman  filter  for  this  tracking  and  estimation 
task  will  be  presented.  All  techniques  and  symbology  of  estimation 
theory  implemented  in  this  thesis  are  derived  from  Wiesel  (3:1-1^) 


except  when  annotated  otherwise. 


Data  Vector 


The  data  vector,  z,  input  to  the  Kalman  filter  is  a  tK)  element 
vector  consisting  of  the  current  longitude  IX)  and  latitude  (6)  of  the 
TAV; 

z  =  C  X  <5  )  Cl.i) 

The  data  elements  in  this  vector  result  from  the  proproct?ssing  of  raw 
sensor  azinuth  and  elevation  angles.  They  are  presented  to  the  filter 
in  units  of  radians.  Associated  with  each  input,  z,  is  the  data 
covariance  matrix  [0]  developed  m  Chapter  III,  Eqs  (3. 14)-(3. 18' . 

State  Vecto- 

The  state  vector,  x,  being  estimated  by  the  Kalman  filter  algorithm 
is  a  6x1  vector  consisting  of  the  six  TAV  dynamic  parameters  developed 
in  Chapter  1 1 : 

x  =  (\6hVaj  a^)  (<5.2) 

At  each  data  time  (t^)  t(^  filter  propagates  x  over  the  data  interval 
(At)  as  an  initial  estimate  of  the  TAVs  current  state.  This  initial 
estimate  would  be  extremely  precise  if  x  was  propagated  using  a 
numerical  integration  package  such  as  Haming.  Although  Naming  was  well 
suited  for  the  task  of  generating  the  truth  model  for  the  TAV  state  over 
tine,  it  has  drawbacks  to  its  use  in  the  filter  algorithm.  Executing 
the  Haming  integrator  over  every  dots  interval  is  computationally  very 
burdensome  and  best  avoided  if  possible.  A  better  alternative  is  to 
propagate  x  using  a  discrete  time  approximation.  This  approximation 
implies  that  if  the  data  interval  is  made  sufficiently  small,  the  Kalman 
filter  can  accurately  propagate  x  linearly,  in  lieu  of  direct 
integration  of  the  equations  of  motions.  This  is  true  even  if  the 
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equatxcns  of  noticn,  the<nselves,  are  nonlinear.  For  this  thesis,  data 
intervals  of  10  seconds  or  less  wore  emplcyed,  an  interval  range  found 
to  be  small  enough  to  allow  linear  propagation  of  the  iAV  state  vector. 

The  discrete  time  approximation  propagates  x  from  t^  to  by 

“  X ^  •  it  +  {<1.3) 

Incorporating  the  first  order  equations  of  motion  for  each  state  vector 
element  from  Eqs  (2.3),  (2.7),  (2.32),  (2.33),  (2.3<l),  and  (2.35) 


^  1 

(V  -sin  h  /  R  -cos  6  )  - 

\ 

1  •! 

\  i.  e  V  e 

i 

6 

(V  ‘COS  h  )/  R 

<5 

1  e 

V 

h 

-a  .♦  V  +  C(V  ‘sin  h  -sin  6  )/  R  'cos  6  ) 

h 

Tvv  V  «.  ve  V 

V 

a 

•  At-*- 

V 

a 

V 

Xl 

1 

a 

i«.*i 

0 

a 

IX 

a 

n 

a 

TV*X_ 

. 

TV 
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State  Transition  Matrix 

The  discrete  time  propagation  of  x  detailed  in  Eq  ('l.^))  provides 
an  approximate  solution  to  the  TAV  equations  of  motion  in  closed  form: 

x^^^(t)  =  f  [x^(t),  t]  (4.5) 

where  f  Cx^(t),  t]  represents  the  right  hand  sides  of  the  six  equations 
in  Eq  (4.4).  Since  the  state  transition  matrix,  [$],  describes  a  snail 
change  in  the  initial  conditions  of  x  propagating  into  a  change  in  the 
final  conditions: 

CJ(i+l,i)]  =  ^  Cx^(t),  t]j  (4.6) 

or 
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1  0  0  0  0  0 
0  1  0  0  0  0 


(A. 10) 


H  Matrix 

The  H  Matrix,  [H],  relates  the  error  in  the  current  state  estimate 
to  the  error  in  the  reference  trajectory.  It  is  essentially  the 
linearization  of  [6]  with  respect  to  the  state  vector  and  is 
mathematically  expressed 


CH]  = 


^CG3 

dH 


1  0  0  0  0  0 
0  1  0  0  0  0 


(^.11) 


State  Covariance  Matrix 

The  State  Covariance  Matrix,  CP],  is  a  6x6  matrix  of  covariances 
and  variances  associated  with  the  state  vector  elements  at  a  given  point 
in  time.  It  essentially  measures  how  good  the  current  state  vector 
estimate  is.  [P]  is  initialized,  upon  target  acquisition,  assuming 
statistical  independence  tietween  the  elements  of  x.  This  assumption 
reduces  [P]  to  diagonal  form: 

f  n  ^l*Z222ZZ|  a  M  m  • 

°  r  “x  ‘’i  "v  “'a  "a  J 

1  T 

Again,  this  assumption  is  true  only  for  the  initial  data  point  in  a 
trajectory.  Subsequent  iterations  and  data  points  will  result  in 
nonzero  covariances  in  CP]. 

Kalman  filters  require  a  reasonable  initial  estimate  of  CP]  to 
begin  productive  processing.  The  initial  guess  involves  a  compromise 
between  a  [P]  reflecting  accurate  data  and  a  [P]  reflecting  inordinately 
inaccurate  data.  The  Kalman  filter  will  not  start  properly  in  the  event 
of  either  extreme.  A  suitable  [P]  for  initializing  the  filter  for  this 
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thesis  sets  all  variances  ec^al  to  3  x  10  where  o\  ,  cr\  arid  o*  have 

\  o  n 

units  of  rad^,  C7^  units  of  DU^/TU“  and  the  acceleration  variances 

(c*  and  <7*  )  units  of  DU^/TU"*  or  G^. 
a  a 

X  T 

[Xiring  the  interval  betv-xsen  data  pxsints,  the  goodness  of  the  last 
state  estimate  degrades  as  the  TAV  remains  dynamic.  This  degradation  in 
the  accuracy  of  the  estimate  is  reflected  through  the  propagation  of  [P] 
over  the  data  interval.  In  executing  this  propagation  of  CP]|  a 
subtlety  of  Kalman  filters  must  be  reckoned  with;  tl^e  variances  of  [P] 
must  be  prevented  from  i30.vng  to  zero.  Should  the  zeros  occur, 
increasing  state  residuals  are  ignored  and  the  filter  estimates  cease  to 
be  useful.  This  result  is  particularly  unacceptable  for  the  problem  at 
hand  because  the  TAV  system  is  modelled  by  stochastic  dynamics.  This 
infers  the  variances  should  never  be  zero,  but  must  always  reflect  the 
reality  of  unpredictable  dynamic  inputs.  In  order  to  estimate 
stochastic  dynamics  the  Kalman  filter  must  be  "advised"  of  the  constant 
uncertainty  through  non-zero  variances.  Since  the  filter,  with  ffach 
successive  data  point,  tends  to  drive  CP3-»0,  techniques  are  employed  to 
inject  additional  uncertainty  into  the  [P]  elements.  For  this  filter, 
that  technique  will  be  noisy  dynamics. 

The  equation  for  propagation  of  [P]  using  noisy  dynamics  is 

CP]  =  C^DCPJC^J]’'  CC][Q  DCC]”^  (4.13) 

n 

where 

CC]  is  a  matrix  of  ones  and  zeros  serving  to  "noise"  the  desired 

elements  of  CP]  with  the  desired  noise  value  from  the  noise  matrix  [Q  ]. 

n 

Simplifying  for  this  scenario 

CCDCQ  DCC]'^  =  rQ  Q  00  □  0  |  (4.14) 

n  •  n.  n  -  n.  n, ,  n  n  J 

X  o  h  V  ax  ax 
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The  values  of  the  diagonal  eletnents  in  [0  ]  ar©  specified  through  the 
tuning  process  addressed  in  the  next  chapter. 

Filter  Equations  and  Algorithm 

The  Kalman  filter  employed  in  this  thesis  is  in  its  iterated  form 
and  is  not  extended.  As  discussed,  the  dynamics  and  the  observation 
relationships  have  been  linearized  and  convergence  will  rarely,  if  ever, 
be  attained  in  one  iteration  (2:7). 


Three  equations  constitute  the  core  of  the  Kalman  filter  algorithm: 


CK]  =  CP(-)3-CTf  •  [^CQ]  +  CT]-CP(-)3-CT]'^j“' 

(4.15) 

CP(+)]  =  [^CI3  -  CK3-CT]j-[P(-)3 

(4.16) 

6x(+)  =  6x(-)  +  CK3-  ^r_  -  CT]-6x(-)j 

(4.17) 

where 

CK]  H  Kalman  (Sain  Matrix 

CP(“)3  =  State  (Variance  Matrix  from  the  previous  estimate 
CP(+)]  s  State  (Zovariancc  Matrix  of  the  new  estimate 

<5x(-)  5  previous  correction  to  the  state  estimate 

6x{+)  =  new  correction  to  the  state  estimate 
[T]  =  CH]-C$] 

Cl]  =  identity  matrix  of  order  of  the  state  vector 
r_  =  data  residual 

In  applying  these  equations  in  the  most  general  Kalman  filter 
algorithm,  [$],  [K],  and  CP(+)]  are  recalculated  for  each  iteration  over 
a  single  da':\  point.  The  considerable  computational  effort  involved  in 
such  a  scheme  was  eliminated,  without  detriment,  by  assuming  that  the 
previous  estimate  is  close  to  tlie  true  state.  This  allows  for  a  single 
reevaluation  of  the  filter  linearizations,  [K],  and  CP(+)]  for  each  data 
point  versus  every  iteration  within  a  data  point.  The  small  data 
intervals  used  in  observing  the  TAV  are  critical  to  the  validity  of  this 
assumption . 
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The  complete  data  processing  algorithm,  including  the  preprocessing 


of  the  azimuth  and  elevation  data,  and  the  Kalman  filter  discussed  in 
this  section  is  incorporated  as  a  flowchart  in  Appendix  A. 
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V.  Tuning  the  Kalm£in  Filter 


The  prazess  of  tuning  the  Kalman  filter  involves  the  evaluation  of 
the  individual  matrix  elements  in  the  simplified  noise  matrix  of  Eq 
(4.1^).  The  objective  of  the  tuning  process  is  to  select  a  combination 
of  the  SIX  noise  elements  producing  the  best  filter  €?stimatos  over  the 
conceivable  envelope  of  TAV  operations.  This  section  elaborates  on  the 
strategy  driving  the  tuning  process  for  the  TAV  tracking  scenario  and 
de  ills  the  final  tuning  results  for  the  six  state  Kalman  filter. 

Tuning  Approach 

Each  diagonal  element  of  the  simplified  noise  matrix  in  Eq  i^.l^l 
reflects  the  degree  of  uncertainty  that  is  being  injected  into  the 
variances  for  each  state  element.  Since  each  of  the  six  diagonal 
elements  have  a  possible  range  of  values  from  zero  to  infinity, 
evaluation  of  all  possible  combinations  is  impossible.  Even  the 
starting  point  from  which  to  begin  the  search  for  a  set  of  noise 
elements  is  difficult  without  some  initial  approach.  The  approach  for 
the  tuning  accomplished  in  this  thesis  was  based  on  observations  of  the 
TAV  equations  of  motion. 

The  TAV  equations  of  motion  for  the  intrack  and  transverse 
acceleration  are  very  limited  in  application.  In  words,  zero  jerk 
implies  the  accelerations  in  both  directions  are  not  changing  —  an 
assumption  that  would  never  allow  the  TAV  pilot  to  alter  the  intrack  and 
transverse  acceleration  initial  conditions  for  the  rest  of  the  flight*. 

If  the  value  of  the  variances  are  thought  of,  in  an  intuitive  sense,  as 
the  degree  of  permission  granted  the  Kalman  filter  to  adjust  the 
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correspcnding  state  ele^rents,  then  the  values  of  Q  and  Q  are 

n  n 

ai  ax 

expected  to  be  large.  Large  acceleration  noise  components  translate  to 
large  acceleration  variances,  which  in  turn  allow  the  filter  to 
significantly  adjust  acceleration  estimates  that  could  be  severely 
inaccurate. 

Por  6,  h,  and  V,  the  dynamics  are  well  defined  and  over 
the  small  data  i -tervals  between  updates  considered  in  this  thesis,  the 
estimates  can  be  expected  to  be  reasonably  close.  Whereas  the  TAV  can 
change  acceleration  from  3.0  to  -3.0  6s,  almost  instantaneously,  it 
cannot  drastically  change  <5,  h,  and  V  unless  a  long  data  interval  is 
employed.  As  a  result,  the  0^  elements  being  added  to  the  variances  for 
X,  6,  h,  and  V  should  be  small,  allowing  only  enough  noise  to 
precipitate  small  corrections  and  prohibit  the  variances  from  going  to 
zero. 

Following  these  two  rules  of  thumb,  the  tuning  process  was  started 

atO  =0  =0  =  0  rads^,  Q  =  0  and  0  =0  =100  uf/TU*. 

n.  n,  n.  n,,  n  n 

X  (5  h  V  ai  ax 

As  alluded  to  earlier,  tuning  is  the  search  for  noise  elements  that 
produce  the  best  filter  estimates  over  a  conceivable  flight  envelope  for 
the  TAV.  Consequently,  the  range  of  TAV  flight  profiles  that  the  Kalman 
filter  can  expect  to  observe  must  be  defined.  This  thesis  considers  TAV 
profiles  that  approach  orbital  velocity  (approximately  1  DU/TU)  and 
incorporate  accelerations  of  up  to  eight  6's.  This  acceleration 
envelope  is  very  liberal  for  any  TAV  developed  in  the  near  future. 
Transverse  G's  are  on  the  order  of  eight  6‘s  for  the  best  fighter 
aircraft,  a  mission  role  that  the  TAV  is  not  envisioned  for,  and  eight 
intrack  G's  should  cover  even  the  worst  case  reentry  scenarios  of  this 
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manned  system. 

Having  established  the  flight  envelope  the  Kalman  filter  is 
designed  to  observe,  a  single  set  of  noise  elements  (0,^  s)  permitting 
accurate  estimation  of  the  TAV  trajectory  at  all  accelerations  is 
required.  For  a  given  data  interval,  a  noise  matrix  that  works  for  an 
eight  G  profile  and  a  zero  G,  great  circle  should  also  work  for  the 
intermediate  values  of  acceleration.  As  a  restilt,  for  a  given  data 
interval,  the  Kalman  filter  was  independently  tuned  to  meet  these  two 
cases  by  themselves.  This  method  produced  two  sets  of  noise  elements 
which  were  then  compromised  to  allow  reasonable  filter  estimation  of 
both  cases  with  aie  set  of  noise  values. 


Tuning  Parameters 

Three  parameters  were  fiarticularly  useful  in  evaluating  tuning  runs 
<nade  for  a  given  data  interval.  These  parameters  were  acceleration 
response,  maximum  error,  and  average  error. 

Acceleration  response,  A^,  measures  the  speed  with  which  the  filter 
recognizes  a  sudden  change  in  the  TAV  acceleration.  It  is  defined  as 
the  time  measured  from  the  instant  the  TAVs  acceleration  changes  to 
the  instant  the  filter's  estimate  is  957.  of  the  true  acceleration  value 


(Figure  5.1 ) . 

Maximum  error,  e  ,  is  the  largest  deviation  of  the  filter  state 
max 

estimate  from  tlie  truth  model.  Mathematically, 
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Figure  5.1.  Acceleration  Response  Definition 


N  =  the  number  of  total  data  points  from  the  trajectory  observed 
t  =  time  of  the  i*’*'  data  point 
Average  error  was  also  calculated  for  all  six  state  elements. 


Tuning  Flight  Profile 

To  standardize  the  tuning  process  and  allow  a  framework  within 
which  to  evaluate  a  variety  of  noise  sets  over  a  number  of  accelerations 
and  data  intervals,  a  standard  flight  profile  was  created.  All  tuning 
runs  were  accomplished  with  this  profile  serving  as  the  truth  model. 
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The  tuning  flight  profile,  in  all  cases,  consisted  of  data  over  a 
^80  second  duration.  EXiring  the  first  60  seconds  of  the  flight,  the  TAV 
flew  a  great  circle,  constant  speed  trajectory.  Follo^jing  this,  an 
intrack  acceleration  of  1  to  8  G*s  was  executed  for  120  seconds.  This 
intrack  maneuver  was  followed  by  a  120  second  interval  of  great  circle, 
constant  speed  flight.  Over  the  subsequent  120  second  interval,  a  1  to 
8  G  transverse  acceleration  was  executed.  To  complete  the  profile,  a 
great  circle  constant  speed  trajectory  was  flown.  Table  V.l  summarizes 
the  standard  flight  profile: 


Table  V.l.  Tuning  Flight  Profile 


Time  Interval 
(sec) 

Duration 

(sec) 

Trajectory 

0-60 

60 

Great  Circle,  Constant  Speed 

61  -  180 

120 

Intrack  Acceleration 

181  -  300 

120 

Great  Circle,  Constant  Speed 

301  -  420 

120 

Transverse  Acceleration 

421  -  480 

60 

Great  Circle,  (Constant  Spaced 

Results 

Having  established  the  flight  profile  and  parameters  to  evaluate 

tuning  runs  with,  tuning  results  can  now  be  addressed. 

The  standard  flight  profile  was  used  to  tune  Kalman  filters  running 

with  three  different  data  intervals:  1,  5  and  10  seconds.  Tuning  was 

initiated  with  the  Q  values  defined  earlier  anu  subsequent  Q  values 

n  n 

were  selected  and  tested  as  changes  in  the  tuning  parameters  dictated. 
Tuning  was  stopped  when  average  error  parameters  ceased  to  improve  with 
changes  to  the  first  two  significant  digits  in  the  acceleration 
terms.  Filters  were  tuned  separately  over  the  the  data  intervals  to 
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optimally  track  the  1  G  and  8  G  acceleration  profiles,  where  an  N  G 
profile  infers  that  both  intrack  and  transverse  accelerations  were  input 
as  N  Gs.  Although  the  0  G  case  is  the  true  low  end  of  the  acceleration 
range,  it  does  not  provide  acceleration  respsonse  data.  Therefore,  a  1  G 
profile  was  used  to  validate  the  lower  acceleration  limit.  In  all 
cases,  thf*  tuned  noises  for  the  i  G  acceleration  case  and  the  0  G 
acceleration  case  were  identical  for  a  given  data  interval. 

The  final  values  for  the  0  elements  are  tabulated  in  Table  V.2  by 


Table  V.2.  Optimal  0^  Values  for  Data  Interval /Accelerations  Cases 


1  Sec  Data  Int 

S  Sec  Data  Int 

10  Sec  Data  Int 

1  G  1  0  G 

1  G  1  8  G 

1  G  1  86 

Tuned 

0  Values 
n 

0 

( r  odB  ^  ) 

.01 

.01 

.01 

.01 

.01 

.01 

0 

"<5 

2 

( r  ads  ) 

.01 

.01 

.01 

.01 

.01 

.01 

Q 

2 

(  r  ads  ) 

0.0 

0.0 

0.0 

0.0 

0.0 

0.0 

0 

"v 

2  2 
(du  /tu  ) 

0.0 

o 

o 

B 

0.0 

0.0 

0.0 

Q 

n 

ai 

(du  /tu  ) 

B 

B 

<s 

2 .  Sx  lO 

Q 

n 

ar 

(du  /tu  ) 

g 

7 

2 . 5X lO 

g 

<s 

2 . 5x lO 
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data  intei  val /acceleration  case.  The  tuning  results  for  these  six 
cases,  including  the  values  calculated  for  the  tuning  para.-neters,  are 
detailed  in  Appendix  B. 

The  objective  of  tuning  separate  filters  for  each  daia  interval  at 

the  expected  boundaries  of  acceleration  was  to  choose  noise  values  (0  ) 

n 

suitable  for  estimation  over  the  entire  TAV  flight  envelope.  Now  that 
the  noise  values  at  the  acceleration  boundaries  have  been  specified, 
these  all  encompassing  noise  values  can  be  selected.  Using  Table  V.2, 
the  noise  values  appropriate  for  operating  a  Kalman  filter  at  each  of 
the  data  intervals  are  listed  in  Table  V.3: 


Table  V.3.  Optimal  Values  for  Data  Intervals 


VI.  Six  State  Kalnvan  Filter  Results 


The  six  state  Kalman  filter  was  tested  for  performance  at  three 

different  data  intervals:  1  second,  5  seconds,  and  10  5<.;onds.  Values 

for  the  filter's  noise  elements  were  derived  from  Table  V.3,  implying 

tlvjt  each  data  interval  specific  filter  differed  in  the  CO  3  set 

n 

employed.  Once  the  three  Kalman  filte  were  tailored  to  incorporate 
their  unique  data  intervals  and  noise  elements,  each  filter  was  tested 
against  flight  profiles  varying  in  acceleration  from  0  to  6  6s.  This 
range  was  tested  at  acceleration  intervals  of  one,  producing  9 
estimation  runs  per  TAV  trajectory  type  tested.  In  addition  to  this 
acceleration  range,  a  special  test  of  the  filter  was  conducted  for  20  G 
accelerations.  Although,  20  Gs  are  beyond  the  reasonable  operational 
envelope  of  a  manned  TAV,  this  case  opens  the  door  to  considering  this 
filter  design  for  tracking  problems  involving  high  G  maneuvers. 

Two  TAV  trajectories  were  flowi  in  simulation  of  data  coming  into 
the  sensor.  The  first  was  the  trajectory  used  to  tune  the  six  state 
filter  in  Chapter  V.  It  consists  of  an  intrack  acceleration  followed  by 
a  transverse  acceleration  of  like  magnitude.  The  second  trajectory 
simulates  simultaneous  intrack  and  trarisverse  accelerations  of  equal 
magnitude. 

Serial  Acceleration  Results 

The  TAV  trajectory  tested  in  this  section  consisted  of  an  intrack 
acceleration  followed  separately  by  a  transverse  acceleration  of  equal 
magnitude.  This  480  second  data  profile  is  summarized  in  detail  in 
Table  VI, 1: 
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Table  VI. i.  Serial  Acceleraticn  Test  Trajectory 


Time  Interval 
(sec) 

IXiration 

(sec) 

Trajt?ctory 

0-60 

60 

Great  Circle,  Constant  Speed 

61  -  100 

120 

Intrack  Acceleration 

181  -  300 

120 

Great  Circle,  (Osnstant  Speed 

301  -  ^20 

120 

Transverse  Acceleration 

421  -  480 

60 

Great  Circle,  Constant  Speed 

As  a  visual  aid  to  grasping  the  trajectories,  this  thesis  produced 
code  that  receives  the  truth  model  longitude  and  latitude  as  input  and 
outputs  the  TAV  trajectory  on  a  2-D  projection  of  the  earth  as  seen  from 
the  sensor  platform.  The  trajectory  of  the  20  6  serial  acceleration 
case  is  included  in  Figure  6.1. 


Figure  6.1.  Sensor  View  of  Serial  20  6  TAV  Trajectory 


The  20  G  case  was  selected  because  of  the  exaggerated  trajectory  it 


orcxtuseo,  nvaking  it  possible  to  distinguish  tN?  intracK  and  transw^rse 
acceleration  phases.  Note,  the  trajectory  begins  at  the  sensor  nadir  on 
the  equator  and  ends  in  the  northern  latitudes. 

Each  data  interval  specific  Kalman  filter  was  tested  against  the 
serial  trajectory  for  a  total  of  30  filter  estimation  runs.  Results  for 
these  rir>s  are  tatxilated  by  data  interval  in  Tables  VI. 2  -  VI.?  using 
the  tuning  parameters  defined  in  Chapter  V  as  performance  parameters. 

In  addition  to  the  average  error,  maximum  error,  and  acceleration 
response  parameters,  a  detailed  data  point  by  data  point  comparison  of 
the  TAV  trajectory  truth  model  and  the  Kalman  filter  state  estimates  is 
invaluable.  By  overlaying  the  truth  model  and  estimate  in  graphical 
form,  a  visual  sense  of  where  the  filter  estimates  are  close  and  where 
the  filter  estimates  diverge  emergcjs.  This  graphical  technique  could 
have  been  included  as  results  for  every  data  run.  Not  only  would  the 
volume  of  graphs  have  been  overwhelming,  however,  but  it  seen  vould  be 
apparent  that  all  the  graphical  comparisons  pser  state  are  identical  in 
form.  Only  the  values  associated  with  the  particular  graphs  would 
significantly  change.  Since  Tables  VI. 2  -  VI. 7  already  provide  these 
numbers  in  detail,  only  a  single  set  of  graphs  will  be  incorporated 
here.  A  5  second  data  interval  and  4  G  acceleration  profile  was 
selected  to  be  representative  of  all  the  serial  acceleration  tests.  Its 
position  in  the  center  of  the  acceleration  and  data  interval  ranges  make 
it  a  solid  choice.  In  addition,  4  Bs  is  also  fairly  representative  of 
the  maximum  acceleration  expected  for  most  TAV  trajectories.  The 
acceleration  range  was  expanded  to  B  Gs  to  be  vet-y  conservative. 
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Table  VI. 2.  Serial  Acceleration  Errors  for  1  Second  Data  Interval 
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Table  VI. 3.  Serial  Acceleration  Errors  <or  5  Second  Data  Interval 
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Table  VI. Serial  Acceleration  Errors  ■for  10  Second  Data  Interval 
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Figures  6.2  -  6.7  show  this  typical  estimation  vs.  truth  model 
profile  for  6,  h,  V,  a^,  and  a^  in  a  serial  trajectory.  From  the 
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Lgure  6.3.  Kalman  Latitude  Estimate 
(Serial  4  G  :  Data  Interval  =  5  Sec) 


oocrs  oocj-  oo9t  006-2  core  oos’i 


(233^030)  0NiaU3H 
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Igure  6.5,  Kalman  Velocity  Estimate 
(Serial  4  G  :  Data  Interval  =  5  Sec) 
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•figures  for  the  two  position  parameters,  X  and  6,  the  accuracy  hinted  at 
by  the  previously  tabulated  average  error  values  are  borne  out.  The 
truth  model  and  estimated  values  of  these  states  were  so  close  as  to 
make  the  two  lines  indistinguishable.  The  figures  for  heading  and 
velocity  show  estimates  very  close  to  the  truth  model  values  as  well. 

For  the  serial  acceleration  cases,  intract  accelerations  precipitated  a 
divergence  of  the  velocity  estimate  from  the  velocity  truth  model. 
Similarly,  infsjt  of  transverse  accelerations  precipitated  an  interval  of 
divergence  between  the  heading  estimate  and  truth  model.  Both  intervals 
of  divergence  begin  as  soon  as  the  related  accelerations  are  input.  The 
maximum  divergence  between  the  estimate  and  truth  model  usually  occured 
two  data  points  following  termination  of  the  accelerations,  at  which 
point  the  divergence  quickly  diminishes  as  the  estimate  recovers  to 
follow  the  truth  model  again.  The  figures  representing  the  acceleration 
trends  show  the  greatest  estimate  error  around  both  the  inception  and 
completion  of  an  acceleration  interval.  Maxinum  error  always  occured 
one  data  point  after  the  acceleration  was  begun  and  completed.  As  in 
the  case  of  heading  and  velocity,  however,  the  acceleration  estimates 
quickly  corrected  back  to  the  truth  models  in  roughly  three  to  four  data 
points.  This  behavior  was  independent  of  the  size  of  the  data  interval. 

Simultaneous  Acceleration  Results 

Testing  of  the  simultaneous  trajectory  consisted  of  equal  intrack 
and  transverse  accelerations,  simultaneously  in/.ti.\ted  and  terminated 
over  the  same  data  span.  This  profile  is  also  480  seconds  in  length  and 
is  summarized  in  Table  VI. 8; 
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Table  VI. 8.  Sirrultaneous  Acceleration  Test  Trajectory 


Time  Interval 
(sec) 

IXiration 

(sec) 

Trajectory 

0-60 

60 

Great  Circle,  Ctoistant  Speed 

61  -  180 

120 

Intrack  and  Transverse  Accel . 

181  -  300 

120 

Great  Circle,  Constant  Speed 

301  -  ^20 

120 

Great  Circle,  Constant  Speed 

<121  -  480 

60 

Great  Circle,  Constant  Speed 

The  trajectory  is  illustrated  in  Figure  6.8.  The  20  G  acceleration 
profile  was  again  selected  for  its  length  and  exaggerated 
characteristics.  The  direction  of  the  TAV  motion  is  again  from  the 
equatorial  nadir  to  northern  latitudes. 


Figure  6.8.  Sensor  View  of  Sinultane'XiS  20  G  TAV  Trajectory 


Like  the  serial  case,  each  data  interval  specific  Kalman  filter  was 
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tested  against  the  sinultaneous  trajectory  set.  Results  for  these  n;ns 
appear  in  Tables  VI .9  -  VI. 14.,  where  data  is  again  expressed  by  data 
interval  in  terms  of  the  tuning  parameters  discussed  in  Chapter  V. 

Table  VI .9.  Sinultaneous  Acceleration  Errors  for  1  Second  Data  Interval 
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Table  VI. iO.  Simultaneous  Acceleration  Errors  for  5  Second  Data  Interval 
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Table  VI. 11.  Sinultaneous  Acceleration  Errors  for  10  Second  Data  Interval 
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Graphical  depicticns  of  the  5  second  data  interval  and  4  6 
acceleration  case  for  simultaneous  accelerations  are  given  in  Figures 
6.9  -  6.14.  Again,  the  shape  of  these  plots  are  equivalent  in  form  to 
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Figure  6.11.  Kalman  Heading  Estimate 
(Simultaneous  4  G  :  Data  Interval  =  5  Sec) 


the  remaining  data  interval  and  acceleration  cases.  Only  the  relative 
values  vary  •from  case  to  case  as  reflected  in  the  preceding  tables. 

Discussion 

On  the  whole,  the  results  from  the  six  state  Kalman  filter  are  very 
good,  indicating  the  filter  design  may  be  very  appropriate  for  the  TAV 
tracking  problem.  In  terms  of  average  error  over  the  expected  0  to  8  G 
TAV  flight  envelope,  the  10  second  data  interval  filter  estimating  an  8 
G  simultaneous  acceleration  trajectory  fared  the  poorest.  Even  the  data 
from  this  case,  however,  provides  healthy  accuracy  for  estimating  the 
TAV  state.  In  this  case,  the  longitude  and  latitude  estimates, 
determined  to  iO"**  degree  average  accuracy,  translate  to  position  errors 
of  only  6  meters  at  the  equator.  The  average  heading  error  measured  a 
scant  .94  degrees.  The  average  velocity  error  of  275  mph  is  only  1 
percent  of  the  24735  mph  velocity  averaged  by  the  TAV  over  this  profile. 
The  intrack  acceleration  error  of  .89  Gs  is  only  11  percent  of  the  8  G 
maneuver  that  introduced  it  and  finally  the  transverse  acceleration 
error  of  1.14  Gs  is  14  percent  of  the  8  G  maneuver  that  introduced  it. 
These  acceleration  errors  are  but  a  fraction  of  the  magnitude  of  the 
acceleration  maneuvers  themselves,  despite  the  complete  unpredictability 
of  the  maneuvers.  It  should  be  stressed,  again,  this  data  represents 
the  poorest  estimate  from  the  data  tables.  By  dropping  to  a  1  second 
data  interval,  for  example,  the  errors  for  the  same  simultaneous  8  G 
acceleration  trajectory  are  reduced  by  at  least  a  factor  of  101 
Although  applications  can  be  imagined  where  these  errors  are 
unacceptable,  for  tracking  and  analysis  of  TAV  capabilities  this  filter 
is  sufficient. 
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Further  analysis  of  the  results  show  three  distinct  trcrds.  First, 
the  filter  s  pserforfsance  over  serial  acceleration  trajectories  was,  m 
general,  better  than  its  performance  ov-er  the  simultaneous  trajer taries. 
Second,  as  the  magnitude  of  the  acceleraticn  maneuvers  increased,  both 
<jstimaticn  errors  (maKirtum  and  average)  and  the  acceleration  response 
increased.  Third,  decreasing  the  data  interval  effectivel>  reduced  txath 
errors  and  the  acceleration  rospor^se. 

The  superiority  of  the  Kalman  filter  estimates  for  the  serial 
acceleration  profiles  over  the  simultaneous  acceleration  profiles  is 
intuitively  expected.  Simultaneous  accoleraticns  essential l>  introduce 
sudden  step  inputs  to  tKi  of  the  six  TAV  states.  It  is  not  surprising 
this  results  m  dynamics  more  difficult  to  estimate  than  the  dynamics 
associated  with  introducing  the  step  inputs  to  the  states  one  at  a  time. 
It  IS  important  to  note,  however,  that  the  differences  m  the  estimate 
quality  are  very  slight.  In  addition,  whether  the  simultaneous  or  the 
serial  trajectories  are  being  estimated,  changing  the  data  interval  or 
the  acceleration  maneuver  magnitudes  effects  the  estimation  errors  ard 
acceleration  response  similarly.  This  fact  is  used  to  simplify  the 
discussion  of  the  remaining  two  data  trends.  Only  the  results  for  the 
simultaneous  intrack  and  transverse  accelerations  will  be  examined  in 
support  of  the  discussion  of  these  two  trends.  The  trends  found  to  be 
true  for  the  simultaneous  traj'ectory  are  also  identically  true  for  the 
serial  trajectories.  Detailed  analysis  of  both  would  prove  redundant. 

The  effect  on  the  filter  estimates  of  altering  TAV  acceleration 
magnitude  or  changing  the  data  interval  is  graphically  demonstrated  in 
Figures  6.15-6.21: 
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Figure  6.16.  Latitude  Average  Error  Vs.  TAV  Acceleration 


Figure  6.17.  Heading  Average  Error  Vs.  TAV  Acceleration 


Fi /.re  6.18.  Velocity  Average  Error  Vs.  TAV  Acceleration 
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Specif ic2l ly: 

1)  As  the  magnitude  of  the  acceleraticns  increased,  the  average 
error  for  all  of  the  state  elements  increased.  (Figures  6.15-  6.20) 

2)  As  the  size  of  the  data  intervals  decreased,  the  average  error 
for  all  state  elements  decreased.  (Figures  6.15-6.20) 

3)  As  the  size  of  the  data  interval  increased,  the  acceleration 
response,  in  seconds,  increased.  (Figure  6.21) 

Reproducing  Figures  6.15-6.20,  with  the  vertical  axis  reflecting  maximum 

error,  would  result  in  similiar  graphical  relationships  between  data 

interval  size,  acceleration  magnitudes,  and  e  for  all  state  elements. 

max 

As  the  magnitude  of  accelerations  increased,  maximum  error  for  all  state 
ele(nents  increased,  and  as  the  data  interval  decreased,  the  maximum 
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error  decre^seO. 


The  most  important  imol icatior  oT  the  results  of  this  section  is 
the  critical  impact  data  interval  size  has  on  filter  performance. 
fVccording  to  these  results,  filter  designers  can  theoretically  drive  the 
average  error  and  acceleration  response  to  zero  by  implementing  filte''s 
with  infinitesimally  small  data  intervals.  In  the  case  of  the  average 
error,  a  smaller  data  interval  allows  less  time  for  the  true  TAV  state 
to  diverge  from  the  estimated  state  before  a  fresh  data  jxiint  updates 
the  state.  In  the  case  of  the  acceleration  response,  the  number  of  data 
points  required  to  recover  95  percent  of  the  new  acceleration  value 
doesn't  change,  but  the  sum  duration  of  the  three  intervals  do. 

Therefore  the  smaller  the  data  interval,  the  shorter  the  acceleration 
response.  Unfortunately  for  designers,  budget  constraints  and  computer 
processing  requirements  usually  prevent  actual  specifications  from 
achieving  theoretical  ideals.  Nevertheless,  the  data  interval  provides 
the  designer  with  a  powerful  tool  to  control  filter  accuracy  and 
response  speed. 

20  G  Acceleration  Case 

Accelerations  of  20  6s  represeit  a  substantial  departure  from  the  0 
to  8  6  flight  envelope  already  tested.  The  departure  was  so  substantial 
that  a  Kalman  filter  tuned  to  noise  elements  tabulated  in  Table  V.3  was 
unable  to  estimate  this  acceleration  case.  Instead,  tuning  iterations 
for  each  of  the  data  intervals  were  repeated  for  the  filter.  The  new 
noise  elements  incorporated  into  the  filter  for  the  20  6  acceleration 
case  appear  in  Table  VI. 15: 
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Table  VI. 15.  Optimal  0  Values  for  Data  Intervals  (20  G  Accelerations) 
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.01  .01  0.0  0.0  V.DkIO*"  7.2x10*’ 


1 . Ixio" 

1  .  1  X  1 0 ' 

1.0x10** 

1 . 0x10** 

The  filter  results  for  the  case  of  20  G  intrack  and  transverse 
accelerations  were  natural  extensions  of  the  results  for  the  TAV  range 
of  accelerations.  From  Tables  VI. 2  -  VI .7,  it  is  apparent  that  the 
higher  accelerations  for  this  case  significantly  increased  ti^e  maxinrum 
and  average  errors  relative  to  errors  from  less  dramatic  acceleration 
magnitudes.  This  is  predictable,  given  the  relationship  already  defined 
between  acceleration  magnitude  and  error.  What  the  data  tables  also 
show,  however,  is  that  the  errors  and  acceleration  response  remain 
sensitive  to  the  data  interval  size,  even  at  these  extremely  high  levels 
of  acceleration.  This  is  an  encouraging  result  —  once  again  the  data 
interval  can  be  decreased  to  achieve  relatively  accurate  error  and  speed 
specifications.  Review  of  the  filter  performance  at  20  simultaneous  C3s 
and  a  data  interval  of  1  second  bears  this  out.  For  that  case,  average 
position  errors  on  the  order  of  10  degrees,  average  heading  error  on 
the  order  of  10  ^  degrees,  average  velocity  error  on  the  order  of  61.1 
mph  and  average  acceleration  errors  on  the  order  of  2  6‘s,  are  excellent 
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results.  These  results  support  the  use  of  this  six  state  filter  against 


high  acceleration  systems. 
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Vll .  Four  State  Ele<neot  Kalman  Filter 


In  addition  to  developing  a  six  state  Kalman  filter  to  estimate  the 
TAV  trajectory,  a  Kalman  filter  with  four  state  elements  was  attempted. 
This  chapter  explains  the  impetus  behind  this  second  filter,  the 
filter  s  design,  and  finally,  the  drawbacks  of  the  filters  performance 
in  a  TAV  estimation  problem. 

Design  Intentions 

The  SIX  state  Kalman  filter  estimated  the  intrack  and  transverse 
accelerations  by  including  them  as  state  elements  with  equations  of 
motion 

a^  =  0  (2.34) 

a  «  0  (2.35) 

T 

Because  of  the  unpredictable  nature  of  the  TAV  accelerations,  these 
equations  of  motion  are  a  crude  approximation  to  propagating  the 
accelerations  over  time.  By  adding  very  high  levels  of  noise  to  the 
acceleration  variances,  however,  the  six  state  filter  did  remarkably 
well  in  estimating  tl'e  acceleration  states  over  the  TAV  trajectory.  The 
acceleration  estimates  corresponded  very  accurately  with  the 
acceleration  truth  model,  with  one  notable  exception  —  the  data  points 
coinciding  and  immediately  following  a  step  change  in  the  truth  model 
accelerations. 

Chapter  VI  results  show  that  the  acceleration  estimates  recovered 
95'/.  of  the  true  acceleration  values  only  after  three  data  points  were 
processed  by  the  six  state  filter.  In  light  of  this  finding,  designing 
and  testing  a  four  state  filter  considers  the  following  questions: 
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1)  Could  the  accelerations  be  estinvated  explicitly  by  using  slope 
information  from  velocity  and  heading  estimates  (eg.  a^  =  AV/At) 

instead  of  incorporating  the  accelerations  as  state  elements”’ 

2)  tOould  this  four  state  filter  improve  the  accele’'ation  response”’ 

3)  Are  the  estimates  for  \,  6,  h,  V,  a  ,  and  a  better  than  those 

l’  T 

of  the  six  element  filter"’ 


State  Vector 

The  four  state  vector,  x,  being  estimated  by  the  Kalman  filter 

algorithm  is  a  ^xl  vector  consisting  of  four  of  the  TAV  dynamic 

parameters  developed  in  Chapter  11: 

X  =  (  X  6  h  V  )  (7.1) 

As  in  the  design  of  the  six  state  filter,  a  discrete  time  approximation 

IS  used  to  propagate  x  from  t  to  t  by 

V  v*i 

X  =  X  •  At  +  X 

\.*i  1  i 

Incorporating  the  first  order  equations  of  motion  for  each  state  vector 
element  from  Eqs  (2.3),  (2.7),  (2.32)  and  (2.33) 


■  (V  • 

V 
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(7.3) 


Note  that  the  values  for  a^  and  a_^  are  not  propagated  by  this 
relationship.  Instead,  slope  information  from  the  last  two  TAV 
estimates  are  used  to  calculate  these  quantities.  The  values  for  a^^ 
and  a  .  in  Eq  (7.3)  would  be  computed 

Ti 

a  .  =  (V  -  V  )/At  (7.4) 

II  I  v-l 

and 
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where 


=  |j^h  -  -  |^[^S-sxn  H-Sin  oj/CR^-cos  D)j|  (-S)  (7.5) 


D  =>  (<5  ♦  6  )/2 

V  v-t 

H  =  (h  +  h  )/2 

1  v-i 

S  =  (V  +  V  )/2 

V  v-i 

Although  ccxnplicated  in  appearance,  Eq  (7.5)  simply  reccxgnizes  that  the 
TAVs  total  change  in  heading  includes  a  contribution  from  the  earth's 
rotation.  This  contribution  must  be  subtracted  out  to  exclusively 
determine  t'.'e  contribution  made  to  h  by  any  transverse  acceleration. 


State  Transition  Matrix 

The  discrete  time  propagation  of  x,  detailed  in  Eq  (7.3),  providcfS 
an  approximate  solution  to  the  TAV  equations  of  motion  in  closed  form; 


X  't)  =  f  [x  (t),  t] 


(7.6) 


whe*-e  f  [x^(t),  t]  represents  the  right  hand  sides  of  the  four  equations 
in  Eq  (7.3).  Since  the  state  transition  matrix,  [1],  describes  a  small 
change  in  the  initial  conditions  of  x  propagating  into  a  change  in  the 


final  conditions: 


(1+1,1)]  =  <  Cx^(t),  t]j 


(7.7) 


-3 


d 


Sin  h  'Sin  6 


TX. 


d\  66  av 

a\  a3^  av 

111 

and  all  renvaining  partial  derivatives  equal  zero. 


R  -cos  6 


rj- 


At 


Observaticn  Function 

As  in  the  case  of  the  sik  state  filter,  the  observation  function 
for  the  Tour  state  filter  benefits  from  the  preprocessing  of  the  angles 
data  to  longitude  and  latitude  data.  Since  tPe  longitude  jind  latitude 
data  remain  identically  the  first  two  state  elements  (,\  anj  6): 


10  0  0 
0  10  0 


K 


(7.9) 


H  Matrix 

The  H  matrix,  [H],  relates  the  error  in  the  current  state  estimate 
to  the  error  in  the  reference  trajectory.  It  is  essentially  the 
linearization  of  [G]  with  respect  to  the  state  vector  and  is 
mathematically  expressed  for  the  four  state  Kalman  filter 


CH] 


<9CG3 

6x 


10  0  0 
0  10  0 


(7.10) 


State  Covariance  Matrix 

For  the  four  state  Ka'man  filter,  the  state  covariance  matrix  is  a 
4x4  matrix  of  covariances  and  variances  associated  with  the  state  vector 
elements  at  a  given  point  in  time.  Again  assuming  statistical  independence 
between  the  elements  of  x  at  target  acquisition 

[P]  =  r  "6  S  “V  J  (7.11) 

where  units  of  the  variances  are  identical  to  those  of  the  six  state 
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filter.  As  in  the  case  of  the  six  state  filter,  [P]  was  initialized 
with  all  variances  equal  to  3x10  ^  and  propagated  using  noisy  dynamics 


by 


where 


CP]  “  CJ]CP]C5’]'^  CC3C0  ICC]’"  (7.12) 

n 


CC3C0  3CC3'^  "FOOGDO  0  1  (7.13) 

n  •  n.  n ,  n.  rv  r>  n  J 

\  6  h  V  ai  ar 

The  values  of  the  diagonal  elements  in  [Q^]  M?re  again  specified  through 
the  process  of  tuning. 


Filter  Equations  and  Algorithm 

With  the  exception  of  the  rreans  used  to  propagate  a^  and  a^  for 
the  four  state  Kalman  filter,  the  filter  equations  and  the  hosting 
algorithm  are  idejntical  to  those  of  the  six  state  Kalman  filter  already 
discussed.  The  equations  remain 

CK3  =  CP(-)3*CT3‘^-  [[03*-^  CT3*tP(-)3'CT3’‘j"^ 

CP(-*-)3  =  [^CI3  -  CK3-CT3j-CP(-)3 
6x(-*-)  =  6x(-)  CK3-  j^r^  -  CT3-6x(-)j 

where 

[K3  =  Kalman  Gain  Matri.< 

[P(-)3  =  State  Covariance  Matrix  from  the  previous  estimate 
CP(+)3  =  State  Covariance  Matrix  of  the  new  estimate 

6x(-)  =  previous  correction  to  the  state  estimate 

6x(+)  =  new  correction  to  the  state  estimate 
CT]  =  CH3-C53 

[13  =  identity  matrix  of  order  of  the  state  vector 

r  =  data  residual 
z 

□nee  again  it  was  assumed,  without  detriment,  that  the  previous 
estimate  is  close  to  the  true  state,  allowing  for  a  single  reevaluation 


(7.14) 

(7.15) 

(7.16) 


of  the  filter  linearizations,  CK3,  and  CP(+)3  for  each  data  point  versus 
ever-y  iteration  within  a  data  point.  Small  data  intervals  again  made 


this  assuopticn  viable. 


The  complete  data  processing  algorithm,  including  the  preprocessing 
of  the  azifiuth  and  elevation  data,  and  the  four  state  Kalman  filter 
discussed  in  this  section  is  incorporated  as  a  flow  chart  in  Appendix  C. 

Resui ts 

Very  early  in  the  testing  of  the  four  state  Kalman  filter,  it 
became  obvicus  this  filter  s  estimation  of  TAv  trajectories  was 
generally  inferior  to  the  estimates  of  the  six  element  filter.  Detailed 
testing  was  discontinued  as  soon  as  it  was  determined  that  the  results 
being  generated  by  the  four  state  filter  v«re  consistently  inferior 
across  the  spectrum  of  data  intervals  and  acceleration  ranges.  Because 
of  the  reasonableness  of  the  thought  process  that  led  to  the  development 
of  this  four  element  filter,  however,  typical  results  from  the  filter 
have  been  incorporated  in  this  section.  These  results  serve  to  answer 
the  questicx>s  posed  at  the  beginning  of  the  chapter  where  the  impetus  to 
designing  this  alternative  to  the  six  state  filter  was  discussed. 

Figures  7.1  -  7.6  illustrate  the  pattern  of  estimation  typical  of  a 
four  element  filter  operating  over  the  data  intervals  and  accelerations 
discussed  in  Chapter  VI.  Like  the  six  element  filter,  the  estimated 
longitude  (Figure  7.1)  and  latitude  (Figure  7.2)  values  coincided  nicely 
with  the  position  truth  models.  T(-)e  estimates  for  the  remaining  four 
state  elements,  however,  continuously  fluctuated  about  the  truth  model 
lines.  These  fluctuations  were  particularly  severe  in  the  case  of  the 
acceleration  estimates,  where  the  method  of  estimating  accelerations 
through  slope  information  is  seen  to  produce  drastic  adjustments  over 
short  time  intervals.  The  estimates  for  heading  and  velocity,  both 
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Figure  7.1.  Kalman  Longitude  Estimate 
(4  State  :  Serial  2  G  :  Data  Interval  =  5  Sec) 


Figure  7.2.  Kalman  Latitude  Estimate 
(4  State  :  Serial  2  G  :  Data  Interval  =  5 


Figure  7.3.  Kalman  Heading  Estimate 
(4  State  :  Serial  2  G  :  Data  Interval  =  5  Sec) 
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FILTER  ESTIMfiTE 


Figure  7.6.  Kalman  Transverse  Acceleration  Estimate 
(4  State  :  Serial  2  g  :  Data  Interval  =  5  Sec) 


functicns  of  the  accelerations,  are  i«mediately  influenced  by  these 
acceleration  fluctuations  and  begin  to  fluctuate  in  tandem  with  the 
acceleration  cycles. 

Although,  the  oscillatory  behavior  exhibited  by  the  four  element 
behavior  is  not  desirable  in  an  estimator,  it  nevertheless  rrust  be 
concluded  the  accelerations  can  be  estimatea  explicitly  using  the 
heading  and  velocity  slopes.  From  data  point  •‘o  data  point,  the  four 
state  filter  is  erratic  in  a  dynamic  acceleration  environment,  but  fr.Dm 
an  overall  trajectory  perspective  the  estimates  do  contain  the  same 
information  as  those  of  the  six  element  filter.  By  employing  averaging 
techniques,  the  four  element  estimates  can  conceivably  be  smoothed  out 
to  estimates  closely  following  the  truth  models.  This  "smoothing"  was 
not  attempted  in  this  thesis  but  may  be  an  area  for  further  study. 

In  terms  of  acceleration  response,  A^,  the  four  element  filter  did 
offer  an  improvement  over  the  six  element  filter,  although  the 
improvement  was  slight.  For  a  given  data  interval,  the  four  element 
filter  often  reflected  957.  of  the  value  of  a  recent  acceleration  change 
one  data  point  before  the  six  element  filter.  This  difference  was 
especially  consistent  in  the  intrack  acceleration  estimates.  The 
disadvantage  of  this  response  time,  however,  was  the  tendency  of  the 
four  state  filter  to  overshoot  the  true  acceleration  value  as  soon  as  it 
had  attained  it.  Although  one  data  point  behind  in  acceleration 
response,  the  six  state  filter  settled  to  the  acceleration  truth  model 
very  quickly.  These  results  again  reinforce  the  finding  that  although 
filters  operating  with  the  same  data  intervals  can  have  their 
acceleration  responses  compared  in  terms  of  data  points,  it  is  wiser  to 
consider  acceleration  response  as  a  function  of  data  intervals.  Instead 
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oi  selecting  the  four  state  filter  over  the  six  state  filter  for  its 
faster  acceleration  response,  one  should  instead  modify  the  six  state 
filter  to  opr-ate  at  the  data  interval  providing  the  desired  response. 

In  summary,  the  six  state  filter  was  superior  to  the  four  state 
filter  for  the  TAV  estimation  problem.  Both  filters  were  equally 
matched  in  terms  of  position  estimates,  but  in  terms  of  heading, 
velocity,  and  acceleration  estimates,  the  six  element  filter  was  much 
more  precise  from  a  data  point  to  data  point  perspective. 
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v/lil.  Reccxwneridaticns 


According  to  the  results  presented  in  this  thesis,  ttw  six  state 
Kalman  filter  offers  accurate  and  flexible  estimation  of  a  typical  TAV 
trajectory  observed  from  a  space  platform.  Position,  heading,  velocity, 
and  acceleration  information  provided  by  the  filter  give  not  only  a 
strong  grasp  of  the  whereabouts  and  intentions  of  a  TAV  target,  but  are 
also  an  accurate  tool  by  which  to  assess  the  capabilities  of  such  a 
system  when  other  means  of  access  are  prohibired.  Consideration  of  this 
filter  for  use  in  the  space  to  TAV  tracking  problem  is  encouraged. 

Further  work  to  improve  the  six  state  filter  could  focus  on  making 
the  model  more  realistic.  The  assumptions  of  this  thesis  regarding 
platform  jitter  and  positional  uncertainty  might  be  replaced  by  models 
predicting  such  effects  in  more  detailed  fashion.  The  assumption  making 
the  TAV  an  isotropically  radiating  point  source  might  also  be  replaced 
by  models  representing  the  thermal  signature  of  the  TAV  in  greater 
complexity.  Software  could  then  be  written  to  recognize  this  signature 
against  the  earth  background,  determine  the  TAV’s  center  of  mass  and 
begin  the  tracking  estimation  process.  The  means  by  which  the  Kalman 
filter  first  initializes  after  acquiring  the  TAV  could  also  be  made  more 
realistic.  This  thesis  provided  the  filter  with  an  initial  state 
estimate  very  close  to  the  truth  model  initial  state.  In  reality,  the 
filter  must  determine  this  initial  state  vector  itself,  perhaps  by 
constnjcting  position,  velocity,  heading,  and  acceleration 
approximations  from  the  first  few  data  points.  These  are  but  a  few  of 
the  possible  refinements  necessary  should  this  concept  ever  go 
jiperational . 
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Without  altering  the  ntDdel  and  Yilter  presented  in  this  thesis,  a 
ccnsiderable  amount  of  additional  testing  is  very  desirable  Yor  the  six 
state  Kalman  filter.  Although  rudimentary  tuning  was  accomplished  while 
ccnstructing  a  Kalman  filter  suitable  for  accurate  estimatiOT  of  a  TAV 
trajectory,  a  concerted  fionte  Carlo  analysis  was  not  conducted.  Such  an 
analysis  should  be  performed  to  ensure  the  filter  estimator  is,  on  the 
average,  unbiased  and  that  the  state  covariance  elements  are 
representative  of  the  uncertainty  in  the  estimate.  Oice  this  analysis 
is  completed  in  sufficient  detail,  many  more  variations  to  the  TAV 
trajectory  can  be  tested.  These  variations  could  then  more  deeply 
investigate  Kalman  filter  performance  and  is;olate  the  limitations  of  the 
filter  near  the  apparent  earth  horiron,  at  increasingly  higher 
accelerations,  and  over  smaller  time  intervals  between  significant 
changes  to  acceleration. 

Additional  study  can  also  be  committed  to  improving  the  performance 
of  the  four  state  Kalman  filter.  As  noted  in  Chapter  VII,  optimal 
smoothing  may  make  the  estimation  from  this  filter  more  useable.  In 
general,  however,  study  emphasis  on  the  six  state  filter  is  recommended 
over  the  four  state  filter. 

As  a  final  note,  additional  work  may  be  appropriate  in  addressing 
the  Kalman  filter's  propensity  to  lag  acceleration  changes  by  the  TAV. 

It  might  be  possible  to  build  a  number  of  discrete  Kalman  filters,  each 
operating  at  a  distinct  acceleration  value.  This  filter  set,  working  in 
conjunction  with  software  tasked  to  select  the  appropriate  acceleration, 
could  then  have  specific  filters  swapped  in  and  out  like  filters  over  a 
camera  lens.  This  method  might  improve  the  acceleration  response  and 
assist  in  initializing  the  filter  when  the  TAV  is  first  spotted. 
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Constants  employed  (1:429):  R  =  1  DU  =  6378.145  km 

r  =  42162.93133  km 


w  =  0.0500336565  rad/TU 
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Aopendix  D;  Six  State  Kalman  Filter  Tuning  Output 


In  Chapter  5,  the  six  state  Kalman  filter  0  values  wr-.-e  tuned  over 

n 

six  data  interval  and  acceloraticn  profiles.  This  appendix  details  the 
optimal  0^  values  determined  for  each  case  along  with  t»-^?  values  for  the 
associated  tuning  parameters. 


Table  B.l.  Optimal  Values  fcr  Data  Interval/Accelerations  Cases 
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Table  B.2.  Tuning  Parameters  for  1  Seccnd  Data  Interval/  1  G  Profile 


Transverse  Acceleration  Response: 

3  data  pc'ints 

In track  Acceleration  Response: 

3  data  points 

Maximum  Longitude  Error: 

4.0652E-C0  degrees 

Maximum  Latitude  Error: 

3.5565£-0e  degrees 

Maximum  Heading  Error: 

5.9060G-02  degrees 

Maximum  Velocity  Error: 

12.60&E-00  mph 

Maximum  Intrack  Acceleration  Error: 

L.OOOOE-OO  Gs 

Maximum  Transverse  Acceleration  Error: 

1.0002E-00  Gs 

Average  Longitude  Error: 

9.3226£-10  degrees 

Average  Latitude  Error: 

6.7225E-10  degrees 

Average  Heading  Error: 

1.4351E-02  degrees 

Average  Velocity  Error: 

2.9281E-00  mph 

Average  Intrack  Acceleration  Error: 

6.3503E-O3  Gs 

I  Average  Transverse  Acceleration  Error: 

6.4304E-03  Gs 

Table  B.3-  Tuning  Parameters  for  1  Second  Data  Interval/  0  G  Profile 


Transverse  Acceleration  Response: 

3  data  points 

Intrack  Acceleration  Response: 

3  data  points 

Maximum  Longitude  Error: 

9.4847E-07  degree^ 

Maximum  Latitude  Error: 

3.13CWE-07  degrees 

Maximum  Heading  Error: 

0.1721E-00  degress 

Maximum  Velocity  Error: 

122.A6E-00  mph 

Maximum  Intrack  Acceleration  Error; 

8.0016E-00  Gs 

Maximum  Transverse  Acceleration  Error: 

B.0069E-00  Gs 

Average  Longitude  Error: 

B.4379E-09  degrees 

Average  Latitude  Error; 

3.9488E-09  degrees 

Average  Heading  Error; 

^.ZA02£-02  degrees 

Average  Velocity  Error : 

23.553E-00  mph 

Average  Intrack  Acceleration  Error: 

5.2539E-02  Gs 

Average  Transverse  Acceleration  Error: 

5.3162E-02  Gs 
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Table  B.4.  Tuning  Parameters  for  5  Second  Data  Interval/  1  6  Profile 


I 


Transverse  Acceleration  Response: 
Intrack  Acceleration  Response; 

Maxirrum  Longitude  Error: 

Maximum  Latitude  Error; 

Maximum  Heading  Error; 

Maxinvim  Velocity  Error; 

Maximum  Intrack  Acceleration  Error: 
Maximum  Transverse  Acceleration  Error: 


3  data  points 
3  data  points 

6.2785E-07  degrees 
4.6424E-07  degrees 
0.2721E-00  degrees 
58.266E-00  mph 
1.0003E-00  6s 
l.OOllE-00  Gs 


Average  Longitude  Error: 

Average  Latitude  Error; 

Average  Heading  Error: 

Average  Velocity  Error; 

Average  Intrack  Acceleration  Error: 
Average  Transverse  Acceleration  Error: 


4.&313E-OQ  degrees 
3.0776E-O9  degrees 
7.1894E-02  degrees 
14.770£~00  mph 
3.2101E-02  Gs 
3.2316E-02  Gs 


Table  B.5.  Tuning  Parameters  for  5  Second  Data  Interval/  8  G  Profile 


Transverse  Acceleration  Response;  3  data  points 

Intrack  Acceleration  Response;  3  data  points 


Maximum  Longitude  Error: 

Maximum  Latitude  Error; 

Maximum  Heading  Error; 

Max imam  Velocity  Error: 

Maximum  Intrack  Acceleration  Error; 
Maximum  Transverse  Acceleration  Error: 

Average  Longitude  Error; 

Average  Latitude  Error; 

Average  Heading  Error; 

Average  Velocity  Error; 

Average  Intrack  Acceleration  Error; 
Average  Transverse  Acceleration  Error: 


1.2960E-O5  degrees 
.  1694E-06  degrees 
0.7991E-00  degrees 
465.07E-00  mph 
8.0074E-00  Gs 
8.0317E-00  Gs 

5.579SG-07  degrees 
2.7917E-07  degrees 
0.218CE-C0  degrees 
119.34E~00  mph 
2.6643E-01  Gs 
2.6437E-01  6s 


i 

I 

I 


B-3 


Table  B.6.  Tuning  Parameters  -for  ’.0  Second  Data  Interval/  1  G  Profile 


Transverse  Acceleration  Response: 

3  data  points 

Intrack  Acceleration  Response: 

3  data  points 

Maximum  Longitude  Error: 

8.0031E-06  degrees 

Maximum  Latitude  Error: 

6. 231 5G -06  degrees 

Maximum  Heading  Error: 

0.5704E-00  degrees 

Maximum  Velocity  Error: 

124.76E-00  mph 

Moxitnjm  Intrack  Acceleration  Error: 

1.0039E-00  Gs 

Maximum  Transverse  Acceleration  Error; 

I.OOIBE-OO  Gs 

Average  Longitude  Error; 

1.0665e-06  degrees 

Average  Latitude  Error: 

9.6199E-07  degrees 

Average  Heading  Ei'ror: 

0.144lE-<X)  degrees 

Average  Velocity  Error: 

3l.040e-00  mph 

Average  Intrack  Acceleration  Error; 

6.832eE-02  Gs 

Average  Transverse  Acceleration  Error: 

6.1714E-02  Gs 

Table  B.7.  Tuning  Parameters  for  10  Second  Data  Interval/  8  G  Profile 


Transverse  Acceleration  Respxxise: 

3  data  points 

Intrack  Acceleration  Response: 

3  data  points 

Maximum  Longitude  Error: 

i.4035e-04  degrees 

Maximum  Latitude  Error: 

5.0741E-05  degrees 

Maximum  Heading  Error; 

1.7785E-00  degrees 

Maximum  Velocity  Error; 

995.74E-00  mph 

Maximum  Intrack  Acceleration  Error; 

8.0141E-00  Gs 

Maximum  Transverse  Acceleration  Error: 

8.0263E-00  Gs 

Average  Longitude  Error: 

1.403*78-05  degrees 

Average  Latitude  Error: 

8.0500G-06  degrees 

Average  Heading  Error; 

0.4299E-00  degrees 

Average  Velocity  Error: 

261 . 70E-00  mph 

Average  Intrack  Acceleration  Error; 

5.9445E-01  Gs 

Average  Transverse  Acceleration  Error; 

5.1069E-01  Gs 

B-4 


Appc?ncJix  C:  Four  State  Kalnvan  Filter  Flowchart 


This  appendix  details  the  flowchart  for  the  four  state  Kalmein 
filter  algorithm  used  to  process  incoming  sensor  data.  It  includes  the 
preprocessing  of  data  angles  to  latitude  and  longitude. 
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